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DESCRIPTION 

METHOD AND APPARATUS FOR ACCURATELY DETECTING ATTITUDE 

OP MOVING BODY 

5 

. <Technical Field> 

The present invention relates to a method and apparatus 
for accurately detecting the attitude of a moving body, and 
inparticular to a method and apparatus for accurately detecting, 
10 for example, the attitude of a moving body which can be preferably 
used for measuring the attitude information such as the attitude 
rotation angular velocity and attitude angle of a walking robot, 
in order to control the stable attitude of the walking robot. 

15 <Background Art> 

As described in Japanese Patent Laid-OpenNo. 2001-9772, 
attitude control of a moving body has been made by detecting 
the attitude angle of a single axis attitude of a robot main 
body by the use of a single rate gyroscope and a single 

20 acceleration sensor and feedback of a corresponding signal. 

The attitude sensor output of a rate, gyroscope or an 
acceleration sensor involves a temperature drift. This 
prevents accurate attitude control of a moving body. In 
particular, in case the attitude control of a moving body is 

25 made for a prolonged duration, the drift amount is remarkable 
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so that a walking robot could fall to the ground* 

A first exemplary method to solve these problems is to 
correct the output of an attitude sensor by using a temperature 
sensor. 

5 Although the first solution is effective for a moving 

body equipped with a system providing stable output of a power 
supply to drive an attitude sensor, it cannot control the 
attitude of a moving body with high accuracy in case the output 
of the attitude sensor also varies. In particular, in the case 

10 of a lightweight and compact walking robot including a control 
computer, a sensor, a driving power supply and the like in a 
limited space in the main body, a variation in the load caused 
by arithmetic operation by the control computer triggers a 
variation in the output of the driving power supply, thereby 

15 causing a detection variation and a drift in the attitude angle . 
Thus, the walking robot could fall to the ground even when the 
output of an attitude sensor using a temperature sensor is 
corrected. 

Another method to solve the problem of drift, as described 
20 in Japanese Patent Laid-open No. Hei07-0218269, is to detect 
and correct a drift by using two differential circuits as well 
as a synchronization detector circuit, smoothing circuit and 
a phase shifter circuit - 

The solution requires a complicated circuit design. The 
25 solution compensates for a drift in the sensor output and inputs 
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the resulting output as a control signal to an attitude 
controller for performing control arithmetic operation and the 
like. This approach, however, cannot prevent occurrence of 
a drift as a control signal input to the attitude controller 
5 due to a variation in the driving power supply for the attitude 
controller, that is, a variation in the reference voltage of 
an analog-'to-digital converter circuit . 

Another solution of a problem with drift is for example 
a method for using a combination of a rate gyroscope and an 
10 acceleration sensor to configure an attitude angle detection 
algorithm such as a Kalman filter and detecting an attitude 
angle while correcting a drift in the output of an attitude 
sensor • 

This approach has a problem that the drift in the output 
15 of an acceleration sensor serving to eliminate the drift in 
the output of a rate gyroscope is left uncorrected* Further, 
in an attitude detection algorithm such as a Kalman filter, 
correction of a static (or low-frequency range) attitude angle 
is made, so that it is impossible to accurately detect a dynamic 
20 (or high-frequency range) attitude angle in case a moving body 
is in dynamic motion. Due to such problems, a walking robot 
could fall to the ground even when an attitude angle is detected 
by an attitude angle detection algorithm such as a Kalman filter . 
The invention has been accomplished in order to solve 
25 the problems. A first object of the invention is to provide 
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a high-accuracy attitude detection method and apparatus for 
accurately detecting the attitude information such as the 
rotation angular velocity and acceleration of a moving body. 
A second object of the invention is to provide a 
5 high--accuracy attitude detection method and apparatus for 
accurately detecting the attitude information such as the 
rotation angle and acceleration of a moving body even when a 
power supply for driving attitude detection section such as 
a rotation angular velocity and acceleration also serves as 
10 a power supply which drives section to perform arithiaetic 
operation of the attitude. 

<Disclosure of the Invention> 

In order to solve the above problems/ especially the first 

15 problem, the invention provides a method for accurately 
detecting an attitude of a moving body, the moving body including 
a high-accuracy attitude detection mechanism having a pair of 
a first attitude detection section for detecting the attitude 
of the moving body and a second attitude detection section which 

20 provides an output inverted from that of the first attitude 
detection section, the method comprising the steps of: 
performing arithmetic processing which mutually compensates 
for a variation in the output of both of the attitude detection 
section, and accurately detecting the attitude information of 

25 the moving body* 
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In order to solve the above problems, the invention 
provides an apparatus for accurately detecting an attitude of 
a moving body comprising; a high-accuracy attitude detection 
mechanism having a pair of a first attitude detection section 
5 for detecting the attitude of the moving body and a second 
attitude detection section which provides an output inverted 
from that of the first attitude detection section, the apparatus 
being capable of accurately detecting the attitude information 
of the moving body by incorporating into the high-accuracy 

10 attitude detection mechanism an arithmetic processing feature 
which mutually compensates for a variation in the output of 
both of the attitude detection section. 

According to the method and apparatus of the invention, 
a variation and a drift in the output of attitude detection 

15 section can be mutually compensated for by the arithmetic 
processing in a pair of attitude detection section forming a 
high-accuracy attitude detection mechanism. Even in case a 
temperature drift or the variation of the driving power supply 
for the attitude detection section is present, it is possible 

20 to configure a method and apparatus for accurately detecting 
the attitude of a moving body, 

A specific aspect of the high-accuracy attitude detection 
apparatus of the invention is characterized in that the attitude 
detection section are rate gyroscopes, that a pair of rate 

25 gyroscopes forming a high-accuracy attitude detection 
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mechanism is mounted on the moving body in opposite directions 
to each other, and that the attitude information, or to be more 
specific, the rotation angular velocity, attitude angle or 
rotation angular acceleration of the moving body is detected 
5 by a differential signal obtained from the output signals of 
the rate gyroscopes. 

Another specific aspect of the invention is characterized 
in that the attitude detection section are acceleration sensors , 
that a pair of acceleration sensors forming a high-accuracy 

10 attitude detection mechanism is mounted on the moving body in 
opposite directions to each other, and that the attitude 
information, or to be more specific, the acceleration, 
translation speed, translation travel amount or attitude angle 
of the moving body is detected by a differential signal obtained 

15 from the output signals of the acceleration sensors. 

Another specific aspect of the high-accuracy attitude 
detection apparatus of the invention is characterized in that 
the attitude detection section are inclination sensors, that 
a pair of inclination sensors forming a high-accuracy attitude 

20 detection mechanism is mounted on the moving body in opposite 
directions to each other, and that the attitude information, 
or to be more specific, the inclination angle, rotation angular 
velocity, or rotation angular acceleration of the moving body 
is detected by a differential signal obtained from the output 

25 signals of the inclination sensors* 
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Another specific aspect of the high-accuracy attitude 
detection apparatus of the invention is characterized in that 
the attitude detection section is formed by a pair of rate 
gyroscopes and a pair of acceleration sensors, that each of 
5 the pair of rate gyroscopes and acceleration sensors forming 
a high-accuracy attitude detection mechanism is mounted on the 
moving body in opposite directions to each other, and that the 
attitude information, or to be more specific, the inclination 
angle, rotation angular velocity, or rotation angular 

10 acceleration of the moving body is detected by of a differential 
signal obtained from the differential signal of output signals 
of the rate gyroscopes and that of output signals of the 
acceleration sensors - 

Another specific aspect of the high-accuracy attitude 

15 detection apparatus of the invention is characterized in that 
the attitude detection section is formed by a pair of rate 
gyroscopes and a pair of inclination sensors, that each of the 
pair of rate gyroscopes and the pair of inclination sensors 
forming a high-accuracy attitude detection mechanism is mounted 

20 on the moving body in opposite directions to each other, and 
that the attitude information, or to be more specific, the 
inclination angle, rotation angular velocity, or rotation 
angular acceleration of the moving body is detected by a 
differential signal obtained from the differential signal of 

25 output signals of the rate gyroscopes and that of output signals 
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of the inclination sensors. 

In order to solve the above problems/ especially the second 
problem, the invention provides a method for accurately 
detecting an attitude of a moving body, characterized in that 
5 the moving body includes a control arithmetic processing 
mechanism for detecting the attitude of the moving body by using 
the output of the attitude detection section as an input signal, 
and that the attitude detection section and the control 
arithmetic processing mechanism are driven by a common driving 

10 power supply. The invention also provides an apparatus for 
accurately detecting an attitude of the moving body comprising; 
at least a pair of moving body attitude detection section, and 
a control arithmetic processing mechanism for detecting the 
attitude of the moving body by using the output of the attitude 

15 detection section as an input signal, characterized in that 
the attitude detection section and the control arithmetic 
processing mechanism are connected to a common driving power 
supply. 

According to the high-accuracy attitude detection method 
20 and apparatus, it is possible to mutually compensate for, using 
a control arithmetic processing mechanism, a variation or a 
drift input to the control arithmetic processing mechanism as 
well as a variation or drift in the output of attitude detection 
section. Even in the presence of a temperature drift, the 
25 variation of a driving power to feed power to the attitude 
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detection section, or a variation or a drift in the input to 
the control arithmetic processing mechanism. 

According to the invention, a high-accuracy attitude 
detection apparatus for accurately detecting an attitude of 
5 a moving body is provided, characterized in that the moving 
body is a walking robot* 

According to the invention, it is possible to accurately 
detect the attitude of a walking robot, so that it is possible 
to control the stable attitude of a walking robot, 

10 

<Brief Description of the Drawings> 

Fig. 1 is a conceptual illustrationof an exemplary walking 
robot equipped with a first high-accuracy attitude detection 
mechanism of the invention; 
15 Fig. 2 is a block diagram illustrating an exemplary 

specific configuration of the high-accuracy attitude detection 
mechanism in Fig. 1; 

Fig, 3 is a block diagram illustrating another exemplary 
specific configuration of the high-accuracy attitude detection 
20 mechanism in Fig* 1; 

Fig. 4 is a block diagram illustrating still another 
exemplary specific configuration of the high-accuracy attitude 
detection mechanism in Fig. 1; 

Fig. Sis a conceptual illustrationof an exemplary walking 
25 robot equipped with a second high-accuracy attitude detection 
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mechanism of the invention; 

Fig. 6 is a block diagram illustrating an exemplary 
specific configuration of the high-accuracy attitude detection 
mechanism in Fig, 5; 
5 Fig. 7 is a block diagram illustrating another exemplary 

specific configuration of the high-accuracy attitude detection 
mechanism in Fig, 5; 

Fig, 8 is aconceptual illustrationof an exemplary walking 
robot equipped with a third high-accuracy attitude detection 
10 mechanism of the invention; 

Fig. 9 is a block diagram illustrating an exemplary 
specific configuration of the high-accuracy attitude detection 
mechanism in Fig. 8; 

Fig, 10 is a conceptual illustration of an exemplary 
15 walking robot equipped with a fourth high-accuracy attitude 
detection mechanism of the invention; 

Fig. 11 is a block diagram illustrating an exemplary 
specific configuration of the high-^accuracy attitude detection 
mechanism in Fig. 10; 
20 Fig. 12 is a conceptual illustration of an exemplary 

walking robot equipped with a fifth high-accuracy attitude 
detection mechanism of the invention; 

Fig, 13 is a block diagram illustrating an exemplary 
specific configuration of the high-accuracy attitude detection 
25 mechanism in Fig. 12; 
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Fig, 14 is a conceptual illustration of an exemplary 
walking robot equipped with a sixth high-accuracy attitude 
detection mechanism of the invention; and 

Fig* 15 is a block diagram illustrating an exemplary 
5 specific configuration of the high-accuracy attitude detection 
mechanism in Fig. 14, 

<Best Mode for Carrying Out the Invention> 

In order to describe the invention in more detail, the 

10 invention is described referring to the attached drawings • Fig . 
1 is a conceptual illustration of an exemplary -walking robot 
(moving body) equipped with a first high- accuracy attitude 
detection mechanism of the invention. The walking robot 
comprises a foot 5 at the bottom end of a leg link 4a, 4b supporting 

15 an upper body 3, which are interconnected via actuators 6a, 
6b, 6c. Ahigh-accuracy attitude detection mechanism 1 provided 
n the upper body 3 uses rate gyroscopes 2a, 2b as attitude 
detection section and uses the high-accuracy attitude detection 
mechanism 1 to accurately detect the attitude information such 

20 as the rotation angular velocity or attitude angle of the upper 
body of the walking robot. The pair of rate gyroscopes 2a, 
2b is provided on the moving body with the rate gyroscopes 
arranged in opposite directions to each other. That is, to 
one rate gyroscope 2a is input an inverted output from the other 

25 rate gyroscope 2b. 
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In this case, the output from each of the rate gyroscope 
2a/ 2b is respectively 
6) !=+<<> + CO offset 
CO 2=- CO + 0) of f set 

5 where co is the actual rotation angular velocity of the upper 
body 3 and co offset is a temperature drift or an output variation 
caused by the variation of the driving power supply to feed 
power to the rate gyroscopes 2af 2b. 

A high-accuracy attitude detection mechanism lA in Fig. 

10 2 is used to describe a case where the arithmetic processing 
by the high-accuracy attitude detection mechanism 1 is made 
using the difference between the output signals of the rate 
gyroscopes 2a, 2b, The high-accuracy attitude detection 
mechanism lA comprises a single driving power supply 10 which 

15 drives the high-accuracy attitude detection mechanism lA 
including the rate gyroscopes 2a, 2b ♦ The high-accuracy 
attitude detection mechanism lA adds (subtracts) the output 
signals of the rate gyroscopes 2a, 2b in an adding element 7 
and compensates for the variations in the outputs then performs 

20 arithmetic processing of multiplying the result by 1/2 in a 
multiplying element 8A, thereby accurately detecting the 
rotation angular velocity of the upper body 3 of the walking 
robot • 

In this case, the output: Vout obtained through the 
25 arithmetic processing by the high-accuracy attitude detection 
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taechanism lA is 

VOUt= CO 

and it is possible to correct the temperature drift of the rate 
gyroscopes 2a, 2b and the output variation (cooffset) caused 
5 by the variation of the driving power supply 10 to feed power 
to the rate gyroscopes 2a, 2b and accurately obtain the rotation 
angular velocity of the upper body 3 of the walking robot. 
Fig. 3 shows a case where the differential signal of the 
output signals of the rate gyroscopes 2a, 2b is integrated as 

10 arithmetic processing by the high-accuracy attitude detection 
mechanism IB used instead of the high-accuracy attitude 
detection mechanism lA in Fig. 2. The high-accuracy attitude 
detection mechanism IB comprises a single driving power supply 
10 which drives the high-accuracy attitude detection mechanism 

15 IB including the rate gyroscopes 2a, 2b* The high-accuracy 
attitude detection mechanism IB adds (subtracts) the output 
signals of the rate gyroscopes 2a, 2b in an adding element 7 
and compensates for the variations in the outputs then performs 
arithmetic processing of integration in an integrating element 

20 8B, thereby accurately detecting the attitude angle of the upper 
body 3 of the walking robot. 

In this case, the output: Vout obtained through the 
arithmetic processing by the high-accuracy attitude detection 
mechanism IB is 

25 Vout= J o) dt 



05- 1-21 ; 8:01PM;NGBRM 



MORGAN, LEWIS 



;0355613954 



# 30/ 65 



14 

and it is possible to correct the temperature drift of the rate 
gyroscopes 2a, 2b and the output variation (oaoffset) caused 
by the variation of the driving power supply 10 to feed power 
to the rate gyroscopes 2a, 2b and accurately obtain the attitude 
5 angle of the upper body 3 of the walking robot. 

In case arithmetic processing of differentiation is made 
in a differentiating element 8c instead of the integrating 
element in Fig^ 3, the output: Vout obtained through the 
arithmetic processing by the high-accuracy attitude detection 

10 mechanism IC is differentiation result of integration of the 
above expression. In this case also, it is possible to correct 
the temperature drift of the rate gyroscopes 2a, 2b and the 
output variation (cooffset) caused by the variation of the 
driving power supply 10 to feed power to the rate gyroscopes 

15 2a/ 2b and accurately obtain the rotation angular acceleration 
of the upper body 3 of the walking robot. 

Even in case the attitude detection section in Fig. 1 
is an inclination sensor, it is possible to accurately detect 
the attitude angle of the upper body 3 of the walking robot 

20 based on the same principle as that of the arithmetic processing 
by the high-accuracy attitude detection mechanism lA in Fig. 
2, 

Even in case the attitude detection section in Fig. 1 
is an inclination sensor, it is possible to accurately detect 
25 the rotation angular velocity or rotation angular acceleration 
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of the upper body 3 of the walking robot basedon the same principle 
as that of the arithmetic processing by the high-accuracy 
attitude detection mechanism IC in Fig* 4. 

The embodiment in Fig. 5 shows a case where a second 
5 high-accuracy attitude detection mechanism 11 is provided on 
the upper body 3 of the walking robot in Fig, 1. Attitude 
detection section in the second high-accuracy attitude 
detection mechanism 11 uses a pair of acceleration sensors 12a, 
12b. The attitude information of the upper body 3 of the walking 

10 robot is accurately detected by the high-accuracy attitude 
detection mechanism 11. In the high-accuracy attitude 
detection mechanism 11, in particular, the pair of acceleration 
sensors 12a/ 12b is provided with the acceleration sensors 
arranged in opposite directions to each other. To one 

15 acceleration sensor 12a is input an inverted output from the 
other acceleration sensor 12b, 

The configuration of the walking robot in this embodiment 
is the same as that in Fig, 1 so that the corresponding portions 
in the figure are assigned the same signs and corresponding 

20 description is omitted- This rule also applies to the 
embodiments described below. 

For the above embodiment, the following outputs are 
obtained from the acceleration sensors 12a, 12b: 
a i=+ a+ aof f set 

25 a2=-a + aoffset 
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where os is the actual translation acceleration of the upper 
body 3 andcKoffset is an output variation caused by a variation 
in the driving power supply to feed power to the acceleration 
sensors 12a/ 12b. 
5 A high-accuracy attitude detection mechanism llA in Fig. 

6 is used to describe an aspect where the arithmetic processing 
by the high-accuracy attitude detection mechanism 11 is made 
using the difference between the output signals of the 
acceleration sensors 12a, 12b- The high-accuracy attitude 

10 detection mechanism llA comprises a single driving power supply 
10 which drives the high-accuracy attitude detection mechanism 
llA including the acceleration sensors 12a, 12b. The 
high-accuracy attitude detection mechanism llA adds 
(subtracts) the output signals of the acceleration sensors 12a, 

15 12b in an adding element 13 and compensates for the variations 
in the outputs then performs arithmetic processing of 
multiplying the result by 1/2 in a multiplying element 14, 
thereby accurately detecting the translation acceleration of 
the upper body 3 of the walking robot - 

20 In this case, the output: Vout obtained through the 

arithmetic processing by the high-accuracy attitude detection 
mechanism llA is 
Vout= a 

and it is possible to correct the temperature drift of the 
25 acceleration sensors 12a, 12 and the output variation caused 
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by the variation of the driving power supply 10 to feed power 
to the acceleration sensors 12a, 12b and accurately obtain the 
acceleration of the upper body 3 of walking robot. 

Fig. 7 shows a case where the differential signal of the 
5 output signals of the acceleration sensors 12a, 12b is integrated 
as arithmetic processing by the high-accuracy attitude 
detection mechanism IIB used instead of the high-accuracy 
attitude detection mechanism llA in Fig, 6. The high-accuracy 
attitude detection mechanism IIB comprises a single driving 

10 power supply 10 which drives the high-accuracy attitude 
detection mechanism 1 IB including the acceleration sensors 12a, 
12b. The high-accuracy attitude detection mechanism llB adds 
(subtracts) the output signals of the acceleration sensors 12a, 
12b in an adding element 13 and compensates for the variations 

15 in the outputs or drift then performs arithmetic processing 
of integration in an integrating element 15, thereby accurately 
detecting the translation amount of the upper body 3 of the 
walking robot. 

In this case, the output: Vout obtained through the 

20 arithmetic processing by the high-accuracy attitude detection 
mechanism llB is 

Vout= J J a dt dt 
and it is possible to correct the temperature drift of the 
acceleration sensors 12a/ 12b and the output variation caused 

25 by the variation of the driving power supply 10 to feed power 
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to the acceleration sensors 12a, 12b and accurately obtain the 
translation amount of the upper body 3 of the walking robot • 
In case the integrating element 15 in Fig. 7 employs a 
single integral instead of a double integral, the output: Vout 
5 obtained through the arithmetic processing by the high-accuracy 
attitude detection mechanism 1 IB is a single integral obtained 
from the double integral in the above expression, it is thus 
possible to correct the temperature drift of the acceleration 
sensors 12a, 12b and the output variation causedby the variation 

10 of the driving power supply 10 to feed power to the acceleration 
sensors 12a, 12b and accurately obtain the translation velocity 
of the upper body 3 of the walking robot. 

The embodiment in Fig, 8 shows an arrangement where a 
pair of acceleration sensors 22a, 22b and a pair of acceleration 

15 sensors 22c, 22d are used as attitude detection section for 
a third high-accuracy attitude detection mechanism 21 to be 
provided on the upper body 3 of the walking robot in Fig. 1 
and the attitude angle of the upper body 3 of the walking robot 
can be accurately detected by the high-accuracy attitude 

20 detection mechanisms 21a, 21b each equipped with a pair of 
acceleration sensors. 

On the high^-accuracy attitude detection mechanism 21a 
is provided the pair of acceleration sensors 22a, 22b with the 
acceleration sensors arranged in opposite directions to each 

25 other. On the high-accuracy attitude detection mechanism 2b 
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is provided the pair of acceleration sensors 22c, 22d with the 
acceleration sensors arranged in opposite directions to each 
other . Both of the high-accuracy attitude detect ionmechanisms 
21a/ 21b are arranged orthogonally to each other to form a 
5 high-accuracy attitude detection mechanism 21. 

Fig. 9 explains the aspect of the arithmetic processing 
of the output of the acceleration sensor in the high-accuracy 
attitude detection mechanism 21 in Fig* 8. This arithmetic 
processing allows detection of the attitude angle of the upper 

10 angle 3 of the walking robot. 

To be more specific, the high-accuracy attitude detection 
mechanism 21 comprises a single driving power supply 10 which 
drives the high-accuracy attitude detection mechanisms 21a, 
21b including the acceleration sensors 22a through 22d, The 

15 high-accuracy attitude detection mechanism 21 adds (subtracts) 
the output signals of the acceleration sensors 22a, 22b 
respectively in adding elements 23a, 23b and compensates for 
the variations in the outputs or drifts then performs arithmetic 
processing of multiplying the result by 1/2 in multiplying 

20 elements 24a, 24b, thereby accurately detecting the 
acceleration signals Vout-1 and Vout-2 of the upper body 3 of 
the walking robot in different orientations. 

In this case, the acceleration signal Vout-1 obtained 
from the difference between the output signals of the 

25 acceleration sensors 22a and 22b and the acceleration signal 
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Vout-2 obtained from the difference between the output signals 
of the acceleration sensors 22c and 22d are respectively 

Vout-l=a z 

Vout^2=ax 

5 and, from the difference, it is possible to correct the 
temperature drift of the acceleration sensors 22a/ 22b, 22c, 
22d and the output variation of the driving power supply to 
feed power to the acceleration sensors, thereby accurately 
obtaining the acceleration az, ax of the upper body of the 

10 walking robot . 

The high-accuracy attitude detection mechanisms 2a, 2b 
are arranged orthogonally to each other so that the square root 
of the sum of squares of outputs of the high-accuracy attitude 
detection mechanisms statically matches the gravitational 

15 acceleration • In the two dimension, the arithmetic processing 
shown in Fig. 9, or to be more specific, the arithmetic operation 
of 

Attitude angle (Vout) =tan''Mvout-2/Vout-l) 
by arithmetic elements 25 and 26 is used to accurately obtain 

20 the static attitude angle signal of the upper body 3 of the 
walking robot. It goes without saying that the attitude angle 
signal has undergone correction of the temperature drift of 
the acceleration sensors 22a, 22b, 22c/ 22d and the output 
variation caused by the variation of the driving power supply 

25 10 to feed power to the acceleration sensors. 
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The embodiment in Fig. 10 shows an arrangement where a 
pair of rate gyroscopes 32a, 32b and two pairs of acceleration 
sensors 33a, 33b and 33c, 33d are used as attitude detection 
section for a fourth high-accuracy attitude detection mechanism 
5 31 to be provided on the upper body 3 of the walking robot and 
the attitude angle of the upper body 3 of the walking robot 
can be accurately detected by the high-accuracy attitude 
detectionmechanismSlaequippedwiththe pair of rate gyroscopes 
and the high-accuracy attitude detection mechanisms 31b, 31c 

10 each equipped with the pair of acceleration sensors. 

On the high-accuracy attitude detection mechanism 31b 
is provided the pair of acceleration sensors 33a, 33b with the 
acceleration sensors arranged in opposite directions to each 
other. On the high-accuracy attitude detection mechanism 31c 

15 is provided the pair of acceleration sensors 33c, 33d with the 
acceleration sensors arranged in opposite directions to each 
other . Both of the high-accuracy attitude de tectionmechanisms 
31b, 31c are arranged orthogonally to each other, on the 
high-accuracy attitude detection mechanism 31a is provided a 

20 pair of rate gyroscopes 32a, 32b with the acceleration sensors 
arranged in opposite directions to each other* The 
high-accuracy attitude detection mechanism 31a, 31b, 31c form 
the high-accuracy attitude detection mechanism 31. 

Fig. 11 explains the aspect of the arithmetic processing 

25 in the high-accuracy attitude detection mechanism 31 in Fig. 
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10 . This arithmeticprocessing allows detection of the attitude 
angle of the upper angle 3 of the walking robot. To be more 
specific/ an output signal of each of the acceleration sensors 
33a^ 33b, 33c/ 33dundergoes for example the arithmetic operation 
5 explained using Pig. 9 in an arithmetic element 34 to calculate 
the attitude angle of the upper body 3 of the robot in a low 
frequency range . An output signal of each of the rate gyroscopes 
32a, 32b undergoes for example the arithmetic operation 
explained using Fig. 3 in an arithmetic element 36 to calculate 

10 the attitude angle of the upper body 3 of the robot in a high 
frequency range. The attitude angles are passed through a 
low-pass filter 35 and a high-pass filter 37 and summed up in 
an adding element 38/ in order to accurately detect the attitude 
angle of the attitude angle of the upper body of the robot. 

15 Even in case an existing Kalman filter is configured aster 

a high-accuracy attitude sensor output is calculated in the 
above high-accuracy attitude detection mechanisms 31a, 31b, 
31c, it is possible to form apparatus which accurately detects 
the attitude angle of the upper body of the walking robot. 

20 Further, by adding a differentiating element to the 

processing in the high-accuracy attitude detection mechanism 
31 in Figs» 10 and 11, it is possible to accurately detect the 
rotation angular velocity and rotation angular acceleration 
of the upper body 3 of the walking robot* 

25 Inclination sensors can be used instead of the 
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acceleration sensors 33a through 33d in Figs, 10 and 11. In 
this case also, it is possible to form apparatus which accurately 
detects the attitude angle of the upper body 3 of the walking 
robot based on the same principle as that in Fig. 11, 
5 The embodiment in Fig. 12 shows an arrangement where a 

pair of rate gyroscopes 42a, 42b is used as attitude detection 
section for a fifth high-accuracy attitude detection mechanism 
41 to be provided on the upper body 3 of the walking robot* 
Also, a control arithmetic processing mechanism 43, rate 

10 gyroscopes 42a/ 42b/ and a common driving power supply 40 which 
drives the control arithmetic processing mechanism 43 are 
provided* All these components are used to accurately detect 
the rotation angular velocity and attitude angle of the upper 
body 3 of the walking robot- The pair of rate gyroscope 42a, 

15 42b is provided with the rate gyroscopes arranged in opposite 
directions to each other, same as the previous embodiment. 

In this case, from the rate gyroscopes 42a/ 42b are 
respectively obtained the outputs 
CO l=+a) + Q>of f set 

20 co2=-a) + cDof fset 

where ct) is the actual rotation angular velocity of the upper 
body 3 and <o offset is an output variation caused by a temperature 
drift or a variation in the driving power supply 4 0 to feed 
power to the rate gyroscopes 22a, 22b and a control arithmetic 

25 processing mechanism 43. 
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Fig. 13 explains the aspect of the arithmetic processing 
in the high-accuracy attitude detection mechanism 41 in Fig. 
12. In this embodiment/ the difference between the output 
signals of the rate gyroscopes 42a, 42b is used to accurately 
5 detect the rotation angular velocity of the upper body 3 of 
the walking robot. 

To be more specific, the output signals of the rate 
gyroscopes 42a/ 42b pass through D/A converters 44a/ 44b and 
are added (subtracted) in an adding element 45; and then 
10 multipliedby 1/ (2 XDAGain) in an arithmetic element 46 in order 
to accurately detect the rotation angular velocity of the upper 
body 3 of the walking robot* 

Signals obtained when the outputs of the rate gyroscopes 
42a/ 42b are input to the control arithmeticprocessingmechanism 
15 43 are respectively 

DAco l=DAGainX (H-co-i-coof f set) +DAof fset 

DAco2=DAGainX (-co + cooffset) +DAof fset 

where DAGain is an input gain at the control arithmetic 
processing mechanism 43/ DAcoof f set is an output variation which 
20 takes place at the input to the control arithmetic processing 
mechanism 43 due to the reference voltage variation of a DA 
converter caused by the variation of the common driving power 
supply 40. 

The output: DAout obtained by the internal arithmetic 
25 operation processing by the control arithmetic processing 
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mechanism 43 is 
DAout= a> 

and it is possible to correct the temperature drift of the rate 
gyroscopes 42a, 42b/ the variation of the driving power supply 
5 to feed power to the rate gyroscopes 42a, 42b and a 
variation/drift which takes place at the input of the output 
signals to the control arithmetic processing mechanism 43, and 
accurately obtain the rotation angular velocity of the upper 
body 3 of the walking robot. 

10 In the walking robot in Fig* 12, the internal arithmetic 

processing in the control arithmetic processing mechanism 43 
may include an integration feature, as shown in Fig. 3, This 
provides apparatus which accurately detect the attitude angle 
of the upper body 3 of the walking robot - 

15 Further, the internal arithmetic processing in the 

control arithmetic processing mechanism 43 may include a 
differentiation feature as shown in Fig, 4. This provides 
apparatus which accurately detect the rotation angular 
acceleration of the upper body 3 of the walking robot, 

20 Even in case the attitude detection section in Fig. 12 

is an acceleration sensor or an inclination sensor, it is 
possible to configure apparatus which accurately detect the 
attitude information of a walking robot based on the same 
principle as that of the arithmetic processing by the control 

25 arithmetic processing mechanism 43 in Fig* 13. 
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In case the attitude detection section in Fig. 12 is an 
acceleration sensor and the internal arithmetic processing in 
the control arithmetic processing luechanism 43 includes an 
integration feature as shown in Fig. 7, apparatus is provided 
5 which accurately detects the translation amount and translation 
velocity of the upper body 3 of the walking robot. 

The embodiment in Fig, 14 shows an arrangement where a 
pair of acceleration sensors 52a, 52b and a pair of acceleration 
sensors 52c, 52d are used as attitude detection section for 

10 a sixth high-accuracy attitude detection mechanism 51 to be 
provided on the upper body 3 of the walking robot and the attitude 
information, to be more specif ic, the acceleration, translation 
velocity, translation amoimt or attitude angle of the upper 
body 3 of the walking robot can be accurately detected by the 

15 high-accuracy attitude detection mechanisms 51a, 51b equipped 
with the pairs of acceleration sensors. 

To be more specific, the high-accuracy attitude detection 
mechanism 51 comprises the pair of acceleration sensors 52a, 
52b and the pair of acceleration sensors 52c, 52d in the internal 

20 of the upper body 3 of the walking robot. It also comprises 
a control arithmetic processing mechanism 53 and a common driving 
power supply 50 which drives the acceleration sensors and the 
control arithmetic processing mechanism 53* The pair of 
acceleration sensors 52a, 52b is provided with the acceleration 

25 sensors arranged in opposite directions to each other. The 
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pair of acceleration sensors 52c/ 52d is provided with the 
acceleration sensors arranged in opposite directions to each 
other. The high-accuracy attitude detection mechanisms 51a, 
51b composed of theses components are provide orthogonally to 
5 each other. 

Fig, 15 explains the aspect of the arithmetic processing 
in the control arithmetic processing mechanism 53 in the 
high-accuracy attitude detection mechanism 51 in Fig. 14, In 
the high-accuracy attitude detection mechanism 51, the output 

10 signals of the acceleration sensors 52a, 52b are input to the 
control arithmetic processing mechanism 53 and the 
high-accuracy acceleration signal DAout-1 obtained from the 
difference between the signals and the output signals of the 
accelerationsensors 52c, S2dare input to the control arithmetic 

15 processing mechanism 53 . From the high-accuracy acceleration 
signal DAout-2 obtained from the difference between the signals 
is used to accurately detect the attitude angle of the upper 
body 3 of the walking robot- 

To be more specific, in the control arithmetic processing 

20 mechanism 53, the output signals of the acceleration sensors 
52a^ 52b respectively pass through D/A converters 54a, 54b and 
are added (subtracted) in an adding element 55a. The output 
signals of the acceleration sensors 52c, 52d respectively pass 
through D/A converters 54c, 54d and are added (subtracted) in 

25 an adding element 55b. In arithmetic element 56a, 56b, the 
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resulting values are multiplied by 1/ (2XDAGain) to obtain the 
high-accuracy acceleration signals DAout-1 and DAout-2. 

In this case, the high-accuracy acceleration signal 
DAout-1 obtained by inputting the outputs of the acceleration 
5 sensors 52a, 52b to the control arithmetic processing mechanism 
53 and obtaining the difference is 
DAaut-l=a2 

and the high-accuracy acceleration signal DAout-2 obtained by 
inputting the outputs of the acceleration sensors 52c, 52d to 
10 the control arithmetic processing mechanism 53 and obtaining 
the difference is 
VAout^2=ax* 

It is thus possible to correct the temperature drift of 
the acceleration sensors 52a through 52dr the variation of a 

15 driving power supply to feed power to the acceleration sensors, 
and the variation/drift in the control arithmetic processing 
mechanism 53 which is caused by the variation of the driving 
power supply 50 common to the acceleration sensors 52a through 
52d and the control arithmetic processing mechanism 53, thereby 

20 obtaining the acceleration az, ax of the upper body 3 of the 
walking robot. 

The pair of acceleration sensors 52a, 52b and the pair 
of acceleration sensors 52c, 52d is arranged orthogonally to 
each other, so that the square root of the sum of squares of 

25 outputs of the high-accuracy acceleration sensor signals 
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DAout-1 and the high^accuracy acceleration sensor signals 
DAout-2 operated in the control arithmetic processingraechanism 
53 statically matches the gravitational acceleration. In the 
two dimension, the arithmetic processing shown in Fig. 15, or 
5 to be more specific, the arithmetic operation of 

Attitude angle (DAout) =tan"^ (DAout-2/DAout-l) 
by arithmetic elements 57 and 58 is used correct the temperature 
drift of the acceleration sensors 52a through 52d/ the sensor 
output variation caused by the variation of a coiuiuon driving 

10 power supply 50 to feed power to the acceleration sensors, and 
the variation/drift in the control arithmetic processing 
mechanism 53 which is caused by the variation of the common 
driving power supply 50, thereby obtaining the static attitude 
angle of the upper body 3 of the walking robot, 

15 In the case of the third dimension also, it is possible 

to accurately obtain the static attitude angle of the walking 
robot by an existing calculation method. 

As mentioned in detail hereinabove, according to the 
invention, even in the presence of a temperature drift in 

20 attitude detection section or an output variation caused of 
the variation of a driving power supply to feed power to the 
attitude detection section, the output variations in first 
moving body attitude detection section and second attitude 
detection section which obtains an output inverted from that 

25 of the first attitude detection section aremutually compensated 
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for, which assures high-accuracy detection of the attitude 
information of the moving body* 

Even in case a temperature drift, variation of a driving 
power to feed the attitude detection section, or variation/drift 
5 caused when s signal is input to the control arithmetic mechanism 
is present on the attitude detection section, the first moving 
body attitude detection section and the second attitude 
detection section which obtains an output inverted from that 
of the first attitude detection section are provided and the 
10 attitude detection section and the control arithmetic 
processingmechanism are driven byacommondrivingpower supply, 
which assures high-accuracy detection of the attitude of the 
moving body by the control arithmetic processing mechanism . 

15 <Indu$trial Applicability> 

As mentioned hereinabove, a method and apparatus for 
accurately detecting the attitude of a moving body according 
to the invention is suited for use in an application where the 
attitude information such as the attitude rotation angular 

20 velocity or attitude angle of a walking robot is accurately 
measured in order to assure stable control of the walking robot . 
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[Fig. 2] 

Driving power supply 10 
Rate gyroscope 2a 



[Fig. 3] 

Driving power supply 10 
Rate gyroscope 2a 
Rate gyroscope 2b 

[Fig. 5] 

Driving power supply 10 
Rate gyroscope 2a 
Rate gyroscope 2b 

[Fig. 6] 

Driving power supply 10 
Acceleration sensor 12a 
Acceleration sensor 12b 

[Fig. 7] 

Driving power supply 10 
Acceleration sensor 12a 
Acceleration sensor 12b 



Rate gyroscope 2b 
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[Fig. 9] 

Driving power supply 10 
Acceleration sensor 22a 
Acceleration sensor 22b 
Acceleration sensor 22c 

Acceleration sensor 22d 

[Fig, 11] 

Driving power supply 10 
Acceleration sensor 33a 
Acceleration sensor 33b 
Acceleration sensor 33c 
Acceleration sensor 33d 
Rate gyroscope 32a 
Rate gyroscope 32b 

[Fig. 13] 

Common driving power supply 40 
Rate gyroscope 42a 
Rate gyroscope 42b 
1/ (2XDAGain) 46 



[Fig. 15] 

Common driving power supply 50 
Acceleration sensor 52a 
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Acceleration sensor 52b 
Acceleration sensor 52c 
Acceleration sensor 52d 
l/{2XDAGain) 56a 
l/{2XDAGain) 56b 



